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© An offset-drift correcting device is designed for a 
gyro-sensor mounted on an object and outputting a 
signal representing an angular speed of the object. 
The device includes a first section for detecting 
whether or not the object is rotating. A second 
section connected to the gyro-sensor is operative for 
smoothing the angular speed represented by the 
output signal of the gyro-sensor, and deriving an 
average angular speed of the object from the an- 
gular speed represented by the output signal of the 
gyro-sensor. A third section connected to the first 
section and the second section is operative for es- 
timating an offset level of the output signal of the 



gyro-sensor in response to the average angular 
speed derived by the second section in cases where 
the first section detects that the object is not rotat- 
ing. The third section includes an adaptive filter 
processing an output signal of the second section 
which represents the derived average angular speed. 
A fourth section connected to the gyro-sensor and 
the third section is operative for subtracting the 
offset level estimated by the third section from the 
output signal of the gyro-sensor to convert the out- 
put signal of the gyro-sensor into an offset-free sig- 
nal. 
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BACKGROUND OF THE INVENTION 

Field of the Invention 

This invention relates to an offset-drift correct- 
ing device for a gyro-sensor used in, for example, 
a car navigation system (an automotive navigation 
system). 

Description of the Prior Art 

Some car navigation systems (automotive navi- 
gation systems) include gyro-sensors for detecting 
angular velocities of car bodies (vehicle bodies). 
Generally, the output signal of a gyro-sensor has 
offset components in addition to detected informa- 
tion components. To accurately derive detected 
information from the output signal of the gyro- 
sensor, it is necessary to cancel the offset compo- 
nents in the gyro-sensor output signal. 

In a car navigation system, the amount of offset 
in the output signal of a gyro-sensor tends to be 
drifted by various causes. A prior-art device for 
canceling the signal offset can not adequately fol- 
low certain types of drift of the signal offset. 

SUMMARY OF THE INVENTION 

It is an object of this invention to provide an 
improved offset-drift correcting device for a gyro- 
sensor. 

A first aspect of this invention provides an 
offset-drift correcting device for a gyro-sensor 
mounted on an object and outputting a. signal re- 
presenting an angular speed of the object, the 
device comprising first means for detecting wheth- 
er, or not the object is rotating; second means 
connected to the gyro-sensor for smoothing the 
angular speed represented -by the output signal of 
the gyro-sensor, and deriving an average angular 
speed of the object from the angular speed repre- 
sented by the output signal of the gyro-sensor; 
third means connected to the first means and the 
second means for estimating an offset level of the 
output signal of the gyro-sensor in response to the 
average angular speed derived by the second 
means in cases where the first means detects that 
the object is not rotating, wherein the third means 
comprises an adaptive filter processing an output 
signal of the second means which represents the 
derived average angular speed; and fourth means 
connected to the gyro-sensor and the third means 
for subtracting the offset level estimated by the 
third means from the output signal of the gyro- 
sensor to convert the output signal of the gyro- 
sensor into an offset-free signal. 

A second aspect of this invention provides an 
offset-drift correcting device for a gyro-sensor 



mounted on an object and outputting a signal re- 
presenting an angular speed of the object, the 
device comprising first means for detecting wheth- 
er or not the object is rotating; second means 
5 connected to the gyro-sensor for smoothing the 
angular speed represented by the output signal of 
the gyro-sensor, and deriving an average angular 
speed of the object from the angular speed repre- 
sented by the output signal of the gyro-sensor; 
w third means connected to the second means for 
calculating an amount of temporal variation in the 
average angular speed derived by the second 
means, wherein the third means comprises a low 
pass filter processing an output signal of the sec- 
75 ond means which represents the average angular 
speed; fourth means connected to the third means 
for integrating an output signal of the third means 
which represents the calculated amount of tempo- 
ral variation, and outputting a signal representing a 
20 result of the integrating; fifth means connected to 
the first means and the second means for estimat- 
ing a first offset level of the output signal of the 
gyro-sensor in response to the average angular 
speed derived by the second means in cases 
25 where the first means detects that the object is not 
rotating, wherein the fifth means comprises an 
adaptive filter processing the output signal of the 
second means which represents the derived aver- 
age angular speed; sixth means connected to the 
30 fourth means and the fifth means for combining the 
result of the integrating by the fourth means and 
the first offset level estimated by the fifth means 
into a second estimated offset level of the output 
signal of the gyro-sensor; and seventh means con- 
35 nected to the gyro-sensor and the sixth means for 
subtracting the second estimated offset level pro- 
vided by the sixth means from the output signal of 
the gyro-sensor to convert the output signal of the 
gyro-sensor into an offset-free signal. 
40 A third aspect of this invention provides an 

offset-drift correcting device for a gyro-sensor 
mounted on an object and outputting a signal re- 
presenting an angular speed of the object, the 
device comprising first means for estimating an 
45 angular speed of the object; second means for 
subtracting the angular speed estimated by the first 
means from the angular speed represented by the 
output signal of the gyro-sensor, and outputting a 
signal representing a result of the subtracting; third 
50 means connected to the second means for smooth- 
ing the output signal of the second means, and 
outputting a signal representing a result of the 
smoothing; fourth means connected to the third 
means for estimating an offset level of the output 
55 signal of the gyro-sensor in response to the output 
signal of the third means, wherein the fourth means 
comprises an adaptive filter processing the output 
signal of the third means; and fifth means con- 
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nected to the gyro-sensor and the fourth means for 
subtracting the offset level estimated by the fourth 
means from the output signal of the gyro-sensor to 
convert' the output signal of the gyro-sensor into an 
offset-free signal. 

A fourth aspect of this invention is based on 
the second aspect thereof, and provides an offset- 
drift correcting device further comprising eighth 
means for detecting whether or not the gyro-sensor 
starts to be powered; and ninth means connected 
to the fourth means, the adaptive filter, and the 
eighth means for modifying characteristics of the 
integrating by the fourth means and characteristics 
of the adaptive filter during a predetermined time 
following a moment at which the eighth means 
detects that the gyro-sensor starts to be powered. 

A fifth aspect of this invention is based on the 
second aspect thereof, and provides an offset-drift 
correcting device further comprising eighth means 
for detecting a frequency of occurrence of updating 
of the first offset level estimated by the fifth means; 
and ninth means connected to the first means, the 
adaptive filter, and the eighth means for modifying 
characteristics of the detecting by the first means 
and characteristics of the adaptive filter in response 
to the frequency detected by the eighth means. 

A sixth aspect of this invention is based on the 
second aspect thereof, and provides an offset-drift 
correcting device further comprising eighth means 
for determining desired initial conditions of the 
adaptive filter in response to the output signal of 
the gyro-sensor; and ninth means connected to the 
adaptive filter and the eighth means for setting the 
adaptive filter Into the desired initial conditions de- 
termined by the Eighth means when the adaptive 
filter starts to operate. 

A seventh aspect of this invention provides an 
offset-drift correcting device for a gyro-sensor 
mounted on an object and outputting a signal re- 
presenting an angular speed of the object, the 
device comprising first means for detecting wheth- 
er or not the object is rotating; second means 
connected to the gyro-sensor for smoothing the 
angular speed represented by the output signal of 
the gyro-sensor, and deriving an average angular 
speed of the object from the angular speed repre- 
sented by the output signal of the gyro-sensor; 
third means connected to the second means for 
calculating an amount of temporal variation in the 
average angular speed derived by the second 
means, wherein the third means comprises a low 
pass filter processing an output signal of the sec- 
ond means which represents the average angular 
speed; fourth means connected to the third means 
for integrating an output signal of the third means 
which represents the calculated amount of tempo- 
ral variation, and outputting a signal representing a 
result of the Integrating; fifth means connected to 



the first means and the second means for estimat- 
ing a first offset level of the output signal of the 
gyro-sensor In response to the average angular 
speed derived by the second means in cases 

5 where the first means detects that the object is not 
rotating, wherein the fifth means comprises an 
adaptive filter processing the output signal of the 
second means which represents the derived aver- 
age angular speed; sixth means connected to the 

70 fourth means and the fifth means for combining the 
result of the integrating by the fourth means and 
the first offset level estimated by the fifth means 
into a second estimated offset level of the output 
signal of the gyro-sensor; seventh means connect- 

15 ed to the gyro-sensor and the sixth means for 
subtracting the second estimated offset level pro- 
vided by the sixth means from the output signal of 
the gyro-sensor to convert the output signal of the 
gyro-sensor into an offset-free signal; eighth means 

20 for detecting whether or not the gyro-sensor starts 
to be powered; ninth means connected to the 
fourth means, the adaptive filter, and the eighth 
means for modifying characteristics of the integrat- 
ing by the fourth means and characteristics of the 

25 adaptive filter during a predetermined time follow- 
ing a moment at which the eighth means detects 
that the gyro-sensor starts to be powered; tenth 
means for detecting a frequency of occurrence of 
updating of the first offset level estimated by the 

30 fifth means; eleventh means connected to the first 
means, the adaptive filter, and the tenth means for 
modifying characteristics of the detecting by the 
first means and the characteristics of the adaptive 
filter in response to the frequency detected by the 

35 tenth means; twelfth means for determining desired 
Initial conditions of the adaptive filter in response to 
the output signal of the gyro-sensor; and thirteenth 
means connected to the adaptive filter and the 
twelfth means for setting the adaptive filter into the 

40 desired initial conditions determined by the twelfth 
means when the adaptive filter starts to operate. 

BRIEF DESCRIPTION OF THE DRAWINGS 

45 Fig. 1 is a flow diagram of the function of a 

prior-art offset correcting device. 

Fig. 2 is a block diagram of an offset-drift 
correcting device according to a first embodiment 
of this invention, 
so Fig. 3 is a flow diagram of the function of the 
offset-drift correcting device according to the first 
embodiment. 

Fig. 4 is a time-domain diagram of a gyro- 
sensor output signal and an offset-representing sig- 
55 nal in the offset-drift correcting device according to 
the first embodiment. 

Fig. 5 is a flow diagram of the function of an 
offset-drift correcting device according to a second 
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embodiment of this invention. 

Fig. 6 is a flow diagram of the function of an 
offset-drift correcting device according to a third 
embodiment of this invention. 

Fig. 7 is a diagram of end points XD m _ 1f XD m , 
and XD m+1 in a road link, the center Xc of a circle 
whose circumference extends through the end 
points, the radius R of the circle, and an angular 
variation 0n of a car body. 

Fig. 8 is a flow diagram of the function of an 
offset-drift correcting device according to a fourth 
embodiment of this invention. 

Fig. 9 is a flow diagram of the function of an 
offset-drift correcting device according to a fifth 
embodiment of this invention. 

Fig. 10 is a flow diagram of the function of an 
offset-drift correcting device according to a sixth 
embodiment of this invention. 

Fig. 11 is a flow diagram of the function of an 
offset-drift correcting device according to a seventh 
embodiment of this invention. 

DESCRIPTION OF THE PREFERRED EMBODI- 
MENTS 

First, a prior-art device will be described for a 
better understanding of this invention. Fig. 1 shows 
a prior-art offset correcting device for a gyro-sen- 
sor 101 in a car navigation system. 

With reference to Fig. 1, the gyro-sensor 101 is 
mounted on a car body (not shown). The gyro- 
sensor 101 outputs a signal representing the an- 
gular speed or the angular rate of the car body. 
The prior-art offset correcting device includes a 
sampler 102A which periodically samples the out- 
put signal of the gyro-sensor 101 in response to a 
sampling clock signal generated by a suitable cir- 
cuit (not shown). The sampling-resultant signal is 
fed from the sampler 102A to a switch 105 and a 
subtracter 107. 

A distance sensor 103 mounted on the car 
body outputs a signal representing the distance 
travelled by the car body. The prior-art offset cor- 
recting device includes a sampler 102B which pe- 
riodically samples the output signal of the distance 
sensor 103 in response to the sampling clock sig- 
nal. The sampling-resultant signal is fed from the 
sampler 102B to a stop deciding section 104. 

The samplers 102A and 102B determine tim- 
ings of operation of the prior-art offset correcting 
device. 

The stop deciding section 104 determines 
whether the car body is currently stationary or 
moving by referring to the output signal from the 

: sampler 102B. The stop deciding section 104 gen- 
erates a switch control signal depending on the 

' result of the determination as to whether the car 
body is currently stationary or moving. The stop 



deciding section 104 outputs the switch control 
signal to the switch 105. 

The switch 105 is connected between the sam- 
pler 102A and an averaging section 106. The 

5 switch 105 is opened and closed in response to the 
switch control signal fed from the stop deciding 
section 104. When the stop deciding section 104 
finds the car body to be currently stationary, the 
switch control signal closes the switch 105 so that 

70 the output signal from the sampler 102A is trans- 
mitted to the averaging section 106. When the stop 
deciding section 104 finds the car body to be 
currently moving, the switch control signal opens 
the switch 105 so that the transmission of the 

75 signal from the sampler 102A to the averaging 
section 106 is inhibited. 

In the case where the car body remains sta- 
tionary, that is, in the case where the switch 105 
remains closed, the averaging section 106 tem- 

20 porally averages the output signal from the sampler 
102A during a preset Interval of time. The averag- 
ing-resultant signal is held by a memory within the 
averaging section 106. The averaging-resultant sig- 
nal can be continuously fed from the averaging 

25 section 106 to the subtracter 107 as a signal repre- 
senting offset components of the output signal from 
the sampler 102A. In general, each time the car 
body stops, the averaging section 106 updates the 
offset-representing signal. Furthermore, In the case 

30 where the car body remains stationary for a long 
time, the averaging section 106 periodically up- 
dates the offset-representing signal. 

When the car body starts to move, the switch 
105 is opened by the switch control signal fed from 

35 the stop deciding section 104. In this case, the 
transmission of the signal from the sampler 102A 
to the averaging section 106 is inhibited. On the 
other hand, the latest offset-representing signal 
continues to be fed from the averaging section 106 

40 to the subtracter 107. 

The subtracter 107 subtracts the offset-repre- 
senting signal from the output signal of the sampler 
102A, thereby canceling offset components of the 
output signal of the sampler 102A. The subtracter 

45 107 outputs the subtraction-resultant signal as an 
offset-free signal indicating the angular speed of 
the car body. 

As long as the car body moves or creeps, the 
offset-representing signal remains unchanged. 

so Therefore, even in the case where the car body 
remains moving or creeping for a long time, the 
offset-representing signal continues to be not up- 
dated. Since the offset components of the output 
signal from the sampler 102A tend to vary in such 

55 a long time, the accuracy of the offset-representing 
signal generally decreases as time goes by in the 
case where the offset-representing signal continues 
to be not updated. The decrease In the accuracy of 



4 



7 



EP 0 685 705 A1 



8 



the offset-representing signal results in a decrease 
in the accuracy of the offset-free signal indicating 
the angular speed of the car body. 

First Embodiment 

A first embodiment of this invention will be 
described hereinafter. Fig. 2 shows an offset-drift 
correcting device for a gyro-sensor 1 in a car 
navigation system. 

With reference to Fig. 2, the gyro-sensor 1 is 
mounted on a car body (not shown). The gyro- 
sensor 1 outputs an analog signal representing the 
angular speed or the angular rate of the car body. 
The offset-drift correcting device includes an ana- 
log-to-digital (A/D) converter 81 and a digital signal 
processor 82. The A/D converter 81 periodically 
samples the analog output signal of the gyro-sen- 
sor 1, and converts every sample into a corre- 
sponding digital signal piece. The A/D converter 81 
outputs the resultant digital signal to the digital 
signal processor 82. The digital signal processor 82 
processes the digital output signal of the A/D con- 
verter 81 into an offset-free digital signal represent- 
ing the angular speed of the car body. 

The digital signal processor 82 estimates offset 
components of the digital output signal of the A/D 
converter 81, and subtracts the estimated offset 
components from the digital output signal of the 
A/D converter 81. The digital signal processor 82 
outputs the subtraction-resultant signal as the off- 
set-free digital signal. 

The digital signal processor 82 includes a com- 
bination of an interface circuit (an input/output cir- 
cuit), a processing section, a RAM, and a ROM. 
The digital signal processor 82 operates in accor- 
dance with a program stored in the ROM. 

Fig. 3 is a flow diagram of the function of the 
offset-drift correcting device which is determined 
by the above-indicated program. It should be noted 
that Fig. 3 does not directly show the hardware of 
the offset-drift correcting device. It is a common 
practice in the art to use such a function flow 
diagram in explaining a signal processing device. 

With reference to Fig. 3, a sampling section 1A 
periodically samples the output signal of the gyro- 
sensor 1 in response to a sampling clock signal 
generated by a suitable circuit (not shown). The 
sampling section 1A corresponds to the A/D con- 
verter 81 in Fig. 2. The sampling-resultant signal is 
fed from the sampling section 1A to a subtracting 
section 1 B. 

The subtracting section 1B receives a signal 
from an adaptively filtering section 5 which repre- 
sents estimated offset components of the output 
signal of the sampling section 1A. The subtracting 
section 1B subtracts the offset-representing signal 
from the output signal of the sampling section 1A, 



thereby canceling offset components of the output 
signal of the sampling section 1A. The subtracting 
section 1B outputs the subtraction-resultant signal 
as an offset-free signal indicating the angular 

5 speed of the car body. 

A smoothing section (an averaging section) 2 
smooths the output signal of the subtracting sec- 
tion 1B or temporally averages the output signal of 
the subtracting section 1B during a preset interval 

io of time. Specifically, the smoothing section 2 cal- 
culates a mean value Bn among a given number of 
temporally spaced samples A n , A n --,, A n - 2 , ••• 
represented by the output signal of the subtracting 
section 1B according to the following equation. 

15 

m-1 

Bn = X A n-i/m ...(j) 
1=0 

20 

where "m" denotes the given sample number 
which corresponds to the preset averaging interval. 
The smoothing section 2 feeds the averaging-resul- 

25 tant signal to a switching section 4. 

A deciding section 3 determines whether or not 
the car body Is turning (rotating) by referring to the 
output signal of the subtracting section 1B. Specifi- 
cally, the deciding section 3 calculates the absolute 

30 value of the quantity represented by the output 
signal of the subtracting section 1B. Then, the 
deciding section 3 compares the calculated ab- 
solute value with a predetermined threshold value 
X. When the calculated absolute value is greater 

35 than the predetermined threshold value X, the de- 
ciding section 3 regards the car body as turning 
(rotating). Otherwise, the deciding section 3 re- 
gards the car body as not turning (not rotating). 
The deciding section 3 generates a switch control 

40 signal depending on the result of the determination 
as to whether or not the car body is turning. The 
deciding section 3 outputs the switch control signal 
to the switching section 4. 

The switching section 4 is connected between 

45 the averaging section 2 and the adaptively filtering 
section 5. The switching section 4 is opened and 
closed in response to the switch control signal fed 
from the deciding section 3. When the deciding 
section 3 finds the car body to be not turning, the 

50 switch control signal closes the switching section 4 
so that the output signal from the smoothing sec- 
tion 2 is transmitted to the adaptively filtering sec- 
tion 5. When the deciding section 3 finds the car 
body to be turning, the switch control signal opens 

55 the switching section 4 so that the transmission of 
the signal from the smoothing section 2 to the 
adaptively filtering section 5 is inhibited. 
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The adaptively filtering section 5 generates the 
offset-representing signal from the output signal of 
the smoothing section 2. Specifically, in the case 
where the car body remains not turning, that is, in 
the case where the switching section 4 remains 
closed, the adaptively filtering section 5 periodi- 
cally calculates the current value C n of the offset- 
representing signal from the immediately-preceding 
value C n -i of the offset-representing signal and the 
current value Bn of the output signal of the smooth- 
ing section 2 by referring to the following equation. 

C n = C n -i + cr-Bn (2) 

where "a n denotes a positive constant (a correction 
gain) predetermined in view of the balance be- 
tween the accuracy and the speed of convergence 
of the adaptively filtering process. Accordingly, in 
this case, the adaptively filtering section 5 periodi- 
cally updates the offset-representing signal. 

When the car body turns, the switching section 
4 is opened by the switch control signal fed from 
the deciding section 3. In this case, the transmis- 
sion of the signal from the smoothing section 2 to 
the adaptively filtering section 5 is inhibited. On the 
other hand, the latest offset-representing signal 
continues to be fed from the adaptively filtering 
section 5 to the subtracting section 1B. To this 
end, the adaptively filtering section 5 has the func- 
tion of holding the latest offset-representing signal. 

As understood from the above description, 
even in the case where the car body moves along 
a straight path, the offset-representing signal is 
periodically updated so that the offset-representing 
signal can suitably follow a drift in the offset-com- 
ponents of the output signal from the sampling 
section 1A. Therefore, it is possible to adequately 
cancel the offset components of the output signal 
from the sampling section 1A even when the offset 
components drift. 

With reference to Fig. 4, the offset level (that 
is, the zero-point level) of the output signal from 
the gyro-sensor 1 tends to vary or drift as time 
goes by. In the case where the car body remains 
not turning, the difference between the offset-repre- 
senting signal Cn and the output signal of the gyro- 
sensor 1 is provided by the subtracting section 1 B, 
and the provided difference is temporally averaged 
by the smoothing section 2. In addition, the offset- 
representing signal Cn is periodically updated by 
the adaptively filtering section 5 in response to the 
output signal of the smoothing section 2. 

As shown in Fig. 4, when the car body turns, 
the output signal from the gyro-sensor 1 deviates 
from the offset level. During the turn of the car 
body, the switching section 4 is opened so that the 
transmission of the signal from the smoothing sec- 
tion 2 to the adaptively filtering section 5 is inhib- 



ited. In addition, the offset-representing signal re- 
mains unchanged from the latest state, and the 
latest offset-representing signal continues to be fed 
from the adaptively filtering section 5 to the sub- 

5 tracting section 1B. Accordingly, during the turn of 
the car body, the output signal from the smoothing 
section 2 remains not used in the generation of the 
offset-representing signal while the updating of the 
offset-representing signal continues to be inhibited. 

w As a result, the offset- representing signal Cn 

suitably converges on the offset level (that is, the 
zero-point level) of the output signal from the gyro- 
sensor 1. Furthermore, the offset-representing sig- 
nal promptly follows a drift in the offset level of the 

75 output signal from the gyro-sensor 1 . Thus, during 
the generation of the offset-free signal indicating 
the angular speed of the car body, the offset com- 
ponents of the output signal from the gyro-sensor 1 
can be adequately canceled even when the offset 

20 components drift. 

Second Embodiment 

A second embodiment of this invention is simi- 

25 lar to the embodiment of Figs. 2 and 3 except for 
an additional arrangement described hereinafter. 

Fig. 5 is a flow diagram of the function of an 
offset-drift correcting device according to the sec- 
ond embodiment. With reference to Fig. 5, a 

30 switching section 4A, a low pass filtering section 6, 
an integrating section 7, and an adding section 5A 
sequentially follow a smoothing section 2. The 
switching section 4A is connected to a deciding 
section 3. The adding section 5A is connected 

35 between a subtracting section 1 B and an adaptively 
filtering section 5. 

The deciding section 3 feeds a switch control 
signal to the switching section 4A. The switching 
section 4A is opened and closed in response to the 

40 switch control signal. When the deciding section 3 
finds a car body to be not turning, the switch 
control signal closes the switching section 4A so 
that the output signal from the smoothing section 2 
is transmitted to the low pass filtering section 6. 

45 When the deciding section 3 finds the car body to 
be turning, the switch control signal opens the 
switching section 4A so that the transmission of the 
signal from the smoothing section 2 to the low pass 
filtering section 6 is inhibited. 

so The low pass filtering section 6 serves as a 
first-degree (first-order) filer of the IIR type. When 
the switching section 4A is closed, the low pass 
filtering section 6 processes the output signal of 
the smoothing section 2. Specifically, in the case 

55 where the car body remains not turning, that is, in 
the case where the switching section 4A remains 
closed, the low pass filtering section 6 periodically 
calculates the current value D n of a filter output 
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signal from the immediately-preceding value D n _i 
of the filter output signal and the current value An 
of the output signal of the smoothing section 2 by 
referring to the following equation. 

D n = (1 - WI^Dn-! + W1-An (3) 

where "W1 " denotes a preset parameter determin- 
ing the time constant of the low pass filtering 
section 6. The filter output signal means the filter- 
ing-resultant signal. The low pass filtering section 6 
outputs the filtering-resultant signal to the integrat- 
ing section 7. 

The integrating section 7 integrates the output 
signal of the low pass filtering section 6 into an 
integration-resultant signal. Specifically, the inte- 
grating section 7 periodically calculates the current 
value E n of the integration-resultant signal from the 
immediately-preceding value E n _«i of the integra- 
tion-resultant signal and the current value Dn of the 
output signal of the low pass filtering section 6 by 
referring to the following equation. 

E n = En-! + dt-Dn.0 (4) 

where "dt" denotes a sampling period (that is, the 
interval between the moment of the occurrence of 
the current signal value and the moment of the 
occurrence of the immediately-preceding signal 
value), and "0" denotes an integration gain equal 
to a preset positive constant smaller than 1. The 
integrating section 7 outputs the integration-resul- 
tant signal to the adding section 5A. 

The adding section 5A adds and combines the 
output signal of the adaptively filtering section 5 
and the output signal of the integrating section 7 
into an offset-representing signal. The adding sec- 
tion 5A outputs the offset-representing signal to the 
subtracting section 1B. 

In the offset-drift correcting device of this em- 
bodiment, as a result of the operation of the low 
pass filtering section 6 and the integrating section 
7, the offset-representing signal is able to promptly 
follow a high-rate drift in the offset level of the 
output signal from a gyro-sensor 1 . 

Third Embodiment 

A third embodiment of this invention is similar 
to the embodiment of Fig.. 5 except for an addi- 
tional arrangement described hereinafter. 

Fig. 6 is a flow diagram of the function of an 
offset-drift correcting device according to the third 
embodiment. With reference to Fig. 6, a subtracting 
section 10A is connected between a subtracting 
section 1B and a smoothing section 2. A deciding 
section 3 receives the output signal from the sub- 
tracting section 10A. 



An angular-speed estimating section 10 re- 
ceives the output signal of a CD-ROM drive 8 
which represents digitized road map information. 
The angular-speed estimating section 10 derives 

5 information of a road, along which a car body is 
travelling, from the digitized road map information. 
The angular-speed estimating section 10 receives 
the output signal of a distance sensor 9 which 
represents the distance travelled by the car body. 

to The angular-speed estimating section 10 estimates 
the angular speed of the car body in response to 
the road information and the distance information. 
The angular-speed estimating section 10 feeds the 
subtracting section 10A with a signal representing 

75 the estimated value of the angular speed of the car 
body. 

The subtracting section 10A subtracts the out- 
put signal of the angular-speed estimating section 
10 from the output signal of the subtracting section 

20 1 B. Thus, the estimated value of the angular speed 
of the car body is subtracted from the actual value 
of the angular speed of the car body which is 
represented by the output signal (the offset-free 
signal) of the subtracting section 1B. The subtrac- 

25 ting section 10A feeds the subtraction-resultant sig- 
nal to the smoothing section 2 and the deciding 
section 3. 

When the car body is turning, the subtracting 
section 10A serves to cancel the turn-dependent 

30 components of the input signal to the smoothing 
section 2 and the deciding section 3. Accordingly, 
it is possible to prevent the operation of the 
smoothing section 2 and also the operation of the 
deciding section 3 from being adversely affected 

35 by turn of the car body. In addition, it is possible to 
reduce the number of types of turn of the car body 
which can be sensed by the deciding section 3. 
This number reduction results In an increase in the 
frequency of the occurrence of the updating of an 

40 offset-representing signal. 

The operation of the angular-speed estimating 
section 10 will now be further described. With 
reference to Fig. 7, XD m -i, XD m , and XD m+ i de- 
note positions of end points in a road link while Xc 

45 denotes the coordinates of the center of a circle 
whose circumference extends through the points 
XDm-!, XD m , and XD m+1 . In addition, R denotes the 
radius of the circle, and the suffix "m" denotes a 
link order number. 

so It is now assumed that the position of the car 
body coincides with the position XD m _i at a mo- 
ment t = T n -i, and the position of the car body 
coincides with a position distant from the position 
XD m -i by a distance L at a subsequent moment 

55 t = T n . In this case, the angular variation en of the 
car body which occurs during the interval between 
the moments T n -i and T n is approximately cal- 
culated by referring to the following equation. 
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en = U(2*77.R) (5) 

The angular speed on is calculated according 
to the following equation. 

^n = en/dt (6) 

where "dt" denotes a sampling period equal to the 
interval between the moments T n _ n and T n . In other 
words, dt = (T n - Tn-!). 

As the car body moves, the angular-speed 
estimating section 10 periodically calculates the 
turn radius R from the road map information con- 
cerning a road along which the car body is travel- 
ling. The angular-speed estimating section 10 de- 
rives the movement distance L from the output 
signal of the distance sensor 9. The angular-speed 
estimating section 10 estimates the angular speed 
of the car body in response to the turn radius R 
and the movement distance L by referring to the 
equations (5) and (6). 

More than three end points may be used in 
determining the circle center Xc and the circle 
radius R. The points XD m _i, XD m , and XD m +^ may 
be connected by an interpolation-resultant curved 
line such as a spline function line, and an angular 
variation of the car body may be calculated on the 
basis of the interpolation-resultant curved line. 

Fourth Embodiment 

A fourth embodiment of this invention is similar 
to the embodiment of Fig. 5 except for an addi- 
tional arrangement described hereinafter. 

Fig. 8 is a flow diagram of the function of an 
offset-drift correcting device according to the fourth 
embodiment. With reference to Fig. 8, a start de- 
ciding section 11 is connected to an adaptively 
filtering section 5 and an integrating section 7. 

The start deciding section 1 1 receives the out- 
put signal from a car engine-ignition switch 11 A 
which indicates whether or not the car engine- 
ignition switch is in its on position. The start decid- 
ing section 11 determines whether or not the car 
engine-ignition switch 11 A is moved to the on 
position to start a car engine by referring to the 
output signal from the car engine-ignition switch 
11 A. Since a gyro-sensor starts to be powered or 
activated when the car engine-ignition switch 11 A 
is moved to the on position, the start deciding 
section 11 determines whether or not the activation 
of the gyro-sensor 1 is started. The start deciding 
section 1 1 . generates a gain increasing signal when 
the activation of the gyro-sensor 1 is started. The 
start deciding section 11 continues to output the 
gain increasing signal to the adaptively filtering 
section 5 and the integrating section 7 during a 



given time (for example, several minutes) following 
the moment of the start of the activation of the 
gyro-sensor 1 . When the given time terminates, the 
start deciding section 1 1 stops the outputting of the 

5 gain increasing signal. 

The gain of the correction by the adaptively 
filtering section 5 is increased from a normal gain 
in response to the gain increasing signal fed from 
the start deciding section 11. When the gain in- 

10 creasing signal disappears, the gain of the correc- 
tion by the adaptively filtering section 5 returns to 
the normal gain. The gain of the Integration by the 
integrating section 7 is increased from a normal 
gain in response to the gain increasing signal fed 

75 from the start deciding section 11. When the gain 
increasing signal disappears, the gain of the in- 
tegration by the integrating section 7 returns to the 
normal gain. 

In the offset-drift correcting device of this em- 

20 bodiment, as a result of the operation of the start 
deciding section 11, an offset-representing signal is 
able to promptly follow a high-rate drift in the offset 
level of the output signal from the gyro-sensor 1 
which occurs immediately after the start of the 

25 activation of the gyro-sensor 1 . 

Fifth Embodiment 

A fifth embodiment of this invention is similar 

30 to the embodiment of Fig. 5 except for an addi- 
tional arrangement described hereinafter. 

Fig. 9 is a flow diagram of the function of an 
offset-drift correcting device according to the fifth 
embodiment. With reference to Fig. 9, a correction- 

35 frequency calculating section 12 receives a flag 
Fint generated by a deciding section 3. The flag 
Fint is set to "1" when the deciding section 3 finds 
a car body to be not turning. The flag Fint is reset 
to "0" when the deciding section 3 finds the car 

40 body to be turning. The correction-frequency cal- 
culating section 12 serves as a low pass filter of 
the IIR type. 

Specifically, the correction-frequency calculat- 
ing section 12 periodically calculates a current cor- 

45 rection-frequency H n from the immediately-preced- 
ing correction-frequency H n _i and the value of the 
flag Fint according to the following equation. 



H n = (1 - W^-Hn-T + W2.Fint (7) 

50 

where W2 denotes a preset value corresponding to 
a time constant of the low pass filter provided by 
the correction-frequency calculating section 12. 
The correction-frequency calculating section 12 
55 feeds the deciding section 3, an adaptively filtering 
section 5, and an integrating section 7 with a signal 
representing the calculated correction-frequency 
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In the adaptlvely filtering-section 5, a correction 
gain "a" is modified in response to the correction 
frequency H n as follows. 

a = ao- H n /Ho (8) 

where "ao" denotes a standard correction gain (a 
normal correction gain) and Ho denotes a standard 
correction-frequency (a normal correction-frequen- 
cy). 

In the integrating section 7, an integration gain 
n fi n is modified in response to the correction fre- 
quency H n as follows. 

jS = £o -l-l n /Ho (9) 

where "/So" denotes a standard integration gain (a 
normal integration gain). 

In the deciding section 3, a threshold value X is 
modified in response to the correction frequency 
H n as follows. 

X = Xo-Ho/H n (10) 

where Xo denotes a standard threshold value (a 
normal threshold value). 

When the correction frequency H n drops, the 
threshold value X used in the deciding section 3 is 
increased to compensate for the drop in the correc- 
tion frequency H n . Simultaneously, the correction 
gain "a" used in the adaptively filtering section 5 
and the integration gain "0" used in the integrating 
section 7 are decreased to compensate for a possi- 
ble reduction in the accuracy of an offset-repre- 
senting signal. 

Sixth Embodiment 

A sixth embodiment of this invention is similar 
to the embodiment of Fig. 5 except for an addi- 
tional arrangement described hereinafter. 

Fig. 10 is a flow diagram of the function of an 
offset-drift correcting device according to the sixth 
embodiment. With reference to Fig. 10, an offset- 
drift correcting section 13 receives the output sig- 
nal from a sampling section 1A. The offset-drift 
correcting section 13 periodically calculates an off- 
set level of the output signal from the sampling 
section 1A. The offset-drift correcting section 13 
also periodically calculates a rate of a variation in 
the offset level which agrees with a drift level. The 
offset-drift correcting section 13 can feed informa- 
tion of the calculated offset level and the calculated 
drift level to an adaptively filtering section 5, a low 
pass filtering section 6, and an integrating section 7 
via a switching section 13A. The offset-drift correct- 
ing section 13 can be the prior-art offset correcting 
device of Fig. 1 . 



The offset-level and drift-level information fed 
from the offset-drift correcting section 13 is used in 
initialization of the adaptively filtering section 5, the 
low pass filtering section 6, and the integrating 
5 section 7. Specifically, the current value C n of the 
output signal of the adaptively filtering section 5 is 
initialized to a value F n by referring to the following 
equation. 

io C n = F n (11) 

where the value F n is equal to the offset level 
represented by the information fed from the offset- 
drift correcting section 13. The current value E n of 
75 the output signal of the integrating section 7 is 
initialized to a value of "0" by referring to the 
following equation. 

E n = 0 (12) 

20 

The current value D n of the output signal of the low 
pass filtering section 6 is initialized to a value G n 
by referring to the following equation. 

25 D n = G n (13) 

where value G n is equal to the drift level repre- 
sented by the information fed from the offset-drift 
correcting section 13. 
30 The offset-drift correcting device of this em- 
bodiment has improved characteristics during an 
initial stage of operation. 

Seventh Embodiment 

35 

Fig. 11 is a flow diagram of the function of an 
offset-drift correcting device according to a seventh 
embodiment of this invention which agrees with a 
combination of the embodiment of Fig. 8, the em- 
40 bodiment of Fig. 9, and the embodiment of Fig. 10. 

Claims 

1. j An offset-drift correcting device for a gyro- 
45 sensor mounted on an object and outputting a 

signal representing an angular speed of the 
object, the device comprising: 

first means for detecting whether or not 
the object is rotating; 
so second means connected to the gyro-sen- 

sor for smoothing the angular speed repre- 
sented by the output signal of the gyro-sensor, 
and deriving an average angular speed of the 
object from the angular speed represented by 
55 the output signal of the gyro-sensor; 

third means connected to the first means 
and the second means for estimating an offset 
level of the output signal of the gyro-sensor in 
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response to the average angular speed derived 
by the second means in cases where the first 
means detects that the object is not rotating, 
wherein the third means comprises an adaptive 
filter processing an output signal of the second 5 
means which represents the derived average 
angular speed; and 

fourth means connected to the gyro-sensor 
and the third means for subtracting the offset 
level estimated by the third means from the io 
output signal of the gyro-sensor to convert the 
output signal of the gyro-sensor into an offset- 
free signal. 

2. An offset-drift correcting device for a gyro- 15 
sensor mounted on an object and outputting a 
signal representing an angular speed of the 
object, the device comprising: 

first means for detecting whether or not 
the object is rotating; 20 

second means connected to the gyro-sen- 
sor for smoothing the angular speed repre- 
sented by the output signal of the gyro-sensor, 
and deriving an average angular speed of the 
object from the angular speed represented by 25 
the output signal of the gyro-sensor; 

third means connected to the second 
means for calculating an amount of temporal 
variation In the average angular speed derived 
by the second means, wherein the third means 30 
comprises a low pass filter processing an out- 
put signal of the second means which repre- 
sents the average angular speed; 

fourth means connected to the third means 
for integrating an output signal of the third 35 
means which represents the calculated amount 
of temporal variation, and outputting a signal 
representing a result of the integrating; 

fifth means connected to the first means 
and the second means for estimating a first 40 
offset level of the output signal of the gyro- 
sensor in response to the average angular 
speed derived by the second means in cases 
where the first means detects that the object is 
not rotating, wherein the fifth means comprises 45 
an adaptive filter processing the output signal 
of the second means which represents the 
derived average angular speed; 

sixth means connected to the fourth 
means and the fifth means for combining the 50 
result of the integrating by the fourth means 
and the first offset level estimated by the fifth 
means into a second estimated offset level of 
the output signal of the gyro-sensor; and 

seventh means connected to the gyro-sen- 55 
sor and the sixth means for subtracting the 
second estimated offset level provided by the 
sixth means from the output signal of the gyro- 



sensor to convert the output signal of the gyro- 
sensor into an offset-free signal. 

3. An offset-drift correcting device for a gyro- 
sensor mounted on an object and outputting a 
signal representing an angular speed of the 
object, the device comprising: 

first means for estimating an angular 
speed of the object; 

second means for subtracting the angular 
speed estimated by the first means from the 
angular speed represented by the output, sig- 
nal of the gyro-sensor, and outputting a signal 
representing a result of the subtracting; 

third means connected to the second 
means for smoothing the output signal of the 
second means, and outputting a signal repre- 
senting a result of the smoothing; 

fourth means connected to the third means 
for estimating an offset level of the output 
signal of the gyro-sensor in response to the 
output signal of the third means, wherein the 
fourth means comprises an adaptive filter pro- 
cessing the output signal of the third^means; 
and 

fifth means connected to the gyro-sensor 
and the fourth means for subtracting the offset 
level estimated by the fourth means from the 
output signal of the gyro-sensor to convert the 
output signal of the gyro-sensor into an offset- 
free signal. . 

4. The offset-drift correcting device of claim 2, 
further comprising: 

eighth means for detecting whether or not 
the gyro-sensor starts to be powered; and 

ninth means connected to the fourth 
means, the adaptive filter, and the eighth 
means for modifying characteristics of the in- 
tegrating by the fourth means and characteris- 
tics of the adaptive filter during a predeter- 
mined time following a moment at which the 
eighth means detects that the gyro-sensor 
starts to be powered. 

5. The offset-drift correcting device of claim 2, 
further comprising: 

eighth means for detecting a frequency of 
occurrence of updating of the first offset level 
estimated by the fifth means; and 

ninth means connected to the first means, 
the adaptive filter, and the eighth means for 
modifying characteristics of the detecting by 
the first means and characteristics of the adap- 
tive filter in response to the frequency de- 
tected by the eighth means. 
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The offset-drift correcting device of claim 2, 
further comprising: 

eighth means for determining desired ini- 
tial conditions of the adaptive filter in response 
to the output signal of the gyro-sensor; and 5 

ninth means connected to the adaptive fil- 
ter and the eighth means for setting the adap- 
tive filter into the desired initial conditions de- 
termined by the eighth means when the adap- 
tive filter starts to operate. w 

An offset-drift correcting device for a gyro- 
sensor mounted on an object and outputting a 
signal representing an angular speed of the 
object, the device comprising: 75 

first means for detecting whether or not 
the object is rotating; 

second means connected to the gyro-sen- 
sor for smoothing the angular speed repre- 
sented by the output signal of the gyro-sensor, 20 
and deriving an average angular speed of the 
object from the angular speed represented by 
the output signal of the gyro-sensor; 

third means connected to the second 
means for calculating an amount of temporal 25 
variation in the average angular speed derived 
by the second means, wherein the third means 
comprises a low pass filter processing an out- 
put signal of the second means which repre- 
sents the average angular speed; 30 

fourth means connected to the third means 
for integrating an output signal of the third 
means which represents the calculated amount 
of temporal variation, and outputting a signal 
representing a result of the integrating; 35 

fifth means connected to the first means 
and the second means for estimating a first 
offset level of the output signal of the gyro- 
sensor in response to the average angular 
speed derived by the second means in cases ao 
where the first means detects that the object is 
not rotating, wherein the fifth means comprises 
an adaptive filter processing the output signal 
of the second means which represents the 
derived average angular speed; 45 

sixth means connected to the fourth 
means and the fifth means for combining the 
result of the integrating by the fourth means 
and the first offset level estimated by the fifth 
means into a second estimated offset level of so 
the output signal of the gyro-sensor; 

seventh means connected to the gyro-sen- 
sor and the sixth means for subtracting the 
second estimated offset level provided by the 
sixth means from the output signal of the gyro- 55 
sensor to convert the output signal of the gyro- 
sensor into an offset-free signal; 

eighth means for detecting whether or not 



the gyro-sensor starts to be powered; 

ninth means connected to the fourth 
means, the adaptive filter, and the eighth 
means for modifying characteristics of the in- 
tegrating by the fourth means and characteris- 
tics of the adaptive filter during a predeter- 
mined time following a moment at which the 
eighth means detects that the gyro-sensor 
starts to be powered; 

tenth means for detecting a frequency of 
occurrence of updating of the first offset level 
estimated by the fifth means; 

eleventh means connected to the first 
means, the adaptive filter, and the tenth means 
for modifying characteristics of the detecting 
by the first means and the characteristics of 
the adaptive filter in response to the frequency 
detected by the tenth means; 

twelfth means for determining desired ini- 
tial conditions of the adaptive filter in response 
to the output signal of the gyro-sensor; and 

thirteenth means connected to the adap- 
tive filter and the twelfth means for setting the 
adaptive filter into the desired initial conditions 
determined by the twelfth means when the 
adaptive filter starts to operate. 
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